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Abstract 

In  this  paper,  a  strategy  for  an  autonomous  landing  ma¬ 
neuver  for  an  underactuated,  unmanned  aerial  vehicle 
(UAV)  using  position  information  obtained  from  a  sin¬ 
gle  monocular  on-board  camera  is  presented.  Although 
the  UAV  is  underactuated  in  translational  control  in¬ 
puts  (i.e.,  a  lift  force  can  only  be  produced),  the  pro¬ 
posed  controller  is  shown  to  achieve  globally  uniform  ul¬ 
timate  boundedness  (GUUB)  in  position  regulation  er¬ 
ror  during  the  landing  approach.  The  proposed  vision- 
based  control  algorithm  is  built  upon  homography-based 
techniques  and  Lyapunov  design  methods. 

1  Introduction 

Underactuated  autonomous  vehicles  such  as  underwater  ve¬ 
hicles,  aircrafts,  and  helicopters  are  typically  equipped  with 
a  lower  number  of  control  inputs  than  degrees  of  freedom 
to  reduce  factors  such  as  weight,  complexity,  and  power 
consumption.  As  a  result,  these  vehicles  may  not  be  fully 
equipped  with  sufficient  translational  actuators  that  al¬ 
low  for  independent  translation  along  any  given  direction. 
Hence,  the  control  design  for  these  underactuated  vehicles 
are  complicated  due  to  the  fact  that  the  rotational  torques 
must  be  coupled  with  the  translational  system  in  order  to 
achieve  the  overall  position  objective. 

In  addition  to  the  challenges  involved  in  the  design  of  a 
control  strategy  for  underactuated  dynamic  systems,  there 
exists  the  problem  of  accurate  position  measurement  in  such 
machines.  Flying  machines  are  usually  equipped  with  on¬ 
board  inertial  sensors  which  only  measure  the  rate  of  mo¬ 
tion.  The  position  information  is  thus  obtained  from  time 
integration  of  rate  data,  resulting  in  potential  drift  over 
time  due  to  sensor  noise.  To  overcome  this  problem,  the 
use  of  a  vision  sensor  and  computer  vision  techniques  within 
the  feedback  loop  of  such  systems  is  becoming  increasingly 
attractive,  due  to  their  ever  decreasing  size  and  cost  of  im¬ 
plementation  relative  to  the  computing  power  required  for 
processing  the  visual  data.  Performance  analysis  of  a  vi¬ 
sual  sensor  in  the  feedback  loop  has  been  reported  in  great 
detail  in  [10],  where  visual  data  was  utilized  for  the  estima¬ 
tion  of  position  and  velocity  of  a  helicopter  during  a  landing 
procedure.  Experimental  results  of  this  approach  were  sub¬ 
sequently  published  in  [11].  In  addition,  simulation  results 

1  This  work  was  supported  in  part  by  two  DOC  Grants,  an 
ARO  Automotive  Center  Grant,  a  DOE  Contract,  a  Honda  Cor¬ 
poration  Grant,  and  a  DARPA  Contract. 


for  the  dynamic  control  of  the  X4  flyer  based  on  visual  feed¬ 
back  was  presented  in  [13]. 

In  this  paper,  a  single  calibrated  monocular  camera  is  uti¬ 
lized  as  a  feedback  sensor  within  a  position  regulation  con¬ 
trol  scheme  for  an  unmanned  aerial  vehicle  (UAV)  during 
a  landing  maneuver.  The  UAV  is  assumed  to  be  equipped 
with  Inertial  Navigation  Sensors  (INS)  from  which  veloc¬ 
ity  information  can  be  calculated.  A  homography-based 
approach,  described  in  [12]  and  reported  in  such  visual  ser- 
voing  related  works  as  [2]  and  [14]  has  been  utilized  for  the 
determination  of  the  position  and  orientation  of  the  UAV 
with  respect  to  the  landing  pad.  The  homography-based 
approach  is  well  suited  for  this  application,  since  all  visual 
markers  are  embedded  on  a  flat  planar  landing  pad.  Similar 
to  the  approach  followed  in  [1],  a  constant  design  vector  is 
integrated  within  the  filtered  regulation  error  signal,  result¬ 
ing  in  an  input  matrix  that  facilitates  an  advantageous  cou¬ 
pling  of  translational  dynamics  of  the  UAV  to  the  rotational 
torque  inputs.  Additionally,  the  null  space  of  this  input  ma¬ 
trix  is  exploited  to  achieve  a  secondary  control  objective  of 
damping  the  orientation  error  signal  of  the  UAV  to  within 
a  neighborhood  about  zero  which  can  be  made  arbitrar¬ 
ily  small  through  the  proper  selection  of  design  parameters 
(i.e.,  global  uniform  ultimate  boundedness  (GUUB)). 

The  remainder  of  the  paper  is  organized  in  the  following 
manner.  In  Section  2,  the  geometric  relationship  between 
the  coordinate  frames  of  the  UAV  and  the  landing  pad  are 
expressed  in  terms  of  a  sequence  of  images  of  the  landing 
pad  acquired  from  an  on-board  camera.  A  simplified  dy¬ 
namic  model  of  a  rigid  body,  underactuated  UAV  is  subse¬ 
quently  presented  in  Section  2.2.  The  problem  formulation, 
assumptions,  and  position  regulation  control  objective  are 
presented  in  Section  3.  The  control  development,  based  on 
the  rigid  body  dynamics  and  the  position  error  information 
determined  from  the  vision  system,  are  provided  in  Section 
4  along  with  a  Lyapunov  based  stability  analysis.  Conclu¬ 
sions  are  presented  in  Section  5. 

2  System  Model 

2.1  Vision  System  and  Geometric  Model 

In  order  to  obtain  accurate  position  information,  an  aer¬ 
ial  vehicle  is  outfitted  with  an  on-board  camera  such  that 
the  optical  axis  is  coincident  with  the  vertical  axis  of  the 
UAV  body  fixed  frame,  denoted  by  B.  The  landing  surface, 
denoted  by  7r,  is  augmented  with  many  stationary,  copla- 
nar  visual  markers  Oi,  all  of  them  assumed  to  be  in  the 


Figure  1:  The  relationship  between  inertial  and  body 
fixed  coordinate  frames  for  a  UAV  on  a  landing 
approach. 


field  of  view  of  the  camera  throughout  the  entire  landing 
approach.  The  Euclidean  position  of  the  UAV  with  respect 
to  the  inertial  frame  X  is  represented  by  P(t)  £  R3,  and 
the  orientation  of  the  UAV  B  is  expressed  through  the  ro¬ 
tational  matrix  R(t )  £  50( 3)  where  R(t)  represents  the 
mapping  R  :  B  — >  X.  Bd  represents  the  desired  landing  ori¬ 
entation  of  the  UAV,  Pd  £  R3  denotes  the  desired,  constant 
position  vector,  and  Rd  £  50(3)  denotes  the  constant  or¬ 
thogonal  rotation  matrix  with  the  following  mapping  char¬ 
acteristics  Rd  :  Bd  — >  X.  As  shown  in  Figure  1,  the  transla¬ 
tion  and  rotation  of  the  frame  Bd  relative  to  B  is  quantified 
by  Pe{t)  £  R3  and  Re(t)  £  50(3),  respectively,  where  Re 
represents  the  mapping  Re  :  Bd  — >  B. 

Let  fhi{t),fhid  £  R3  denote  the  Euclidean  coordinates  of 
the  ith  visual  marker  O;  on  the  landing  surface  relative  to 
the  camera  at  position  B  and  Bd,  respectively.  From  the 
geometry  between  the  coordinate  frames,  rhi(t)  and  fhid 
are  related  as  follows 

ffli  =  Pe  +  Refilid ■  (1) 

Also  illustrated  in  Figure  1,  n*  £  R3  denotes  the  known 

constant  normal  to  the  plane  7r  expressed  in  the  coordinates 
of  Bd,  and  the  constant  dn  p  0  £  R  denotes  the  distance  of 
the  landing  surface  7r  from  the  origin  of  the  frame  Bd-  It 
can  be  seen  from  Figure  1  that  for  all  i  visual  markers,  the 
projection  of  fhid  along  the  unit  normal  n, r  is  given  by 

d-r:  =  Tin  fhid-  (2) 

Using  (2),  the  relationship  in  equation  (1)  can  be  expressed 
in  the  following  manner 

(  Re  +  -^-PeTK  )  Tflid 

fhi  =  (3) 

H 


where  H(t)  £  R3x3  represents  a  Euclidean  Homography 
[12].  To  express  the  above  relationship  in  terms  of  the  mea¬ 
surable  image  space  coordinates  of  the  visual  markers  rel¬ 
ative  to  the  camera  frame,  the  normalized  Euclidean  coor¬ 
dinates  mi(t),m,id  £  R3  for  the  visual  markers  are  defined 
as  _ 


A  TTi'i  a  Tflid 

Ttli  =  - ,  Tflid  =  - 

%id 


(4) 


where  Zi(t)  and  Zid  are  the  third  coordinate  elements  in 
the  vectors  fhpt)  and  mu,  respectively.  The  2D  homoge¬ 
neous  image  coordinates  of  the  visual  markers,  denoted  by 
Pi(t),pid  £  R3,  expressed  relative  to  B  and  Bd,  respectively, 
are  related  to  the  normalized  Euclidean  coordinates  by  the 
pin-hole  model  of  [4]  such  that 

Pi  =  Amt,  Pu  =  Amid  (5) 

where  A  £  R3x3  is  a  known,  constant,  upper  triangular  and 
invertible  intrinsic  camera  calibration  matrix  [14].  Hence 
the  relationship  in  (3)  can  now  be  expressed  in  terms  of 
image  coordinates  of  the  corresponding  feature  points  in  B 
and  Bd  as  follows 

Pi  =  —  A  ( Re  +  -^-Pefin^  A^1  Pid 

^  \  dn  )  (6) 

o/-i  G 

where  apt)  £  R  denotes  the  depth  ratio.  The  matrix  G(t)  £ 
R3x3  in  (6)  is  a  full  rank  homogeneous  collineation  matrix 
defined  up  to  a  scale  factor  [14],  and  contains  the  motion 
parameters  Pe(t)  and  Re (t)  between  the  frames  B  and  Bd- 

Given  pairs  of  image  correspondences  ( Pi(t),pu )  for  four 
feature  points  Oi,  at  least  three  of  which  are  non-collinear, 
the  set  of  linear  equations  in  (6)  can  be  solved  to  compute  a 
unique  G(t)  up  to  a  scale  factor  [12].  When  more  than  four 
feature  point  correspondences  are  available,  G(t)  can  also 
be  recovered  (again,  up  to  a  scale  factor)  using  techniques 
such  as  least-squares  minimization.  G(t)  can  then  be  used 
to  uniquely  determine  H(t),  taking  into  account  its  known 
structure  to  eliminate  the  scale  factor,  and  the  fact  that 
the  intrinsic  camera  calibration  matrix  A  is  assumed  to  be 
known  [12].  By  utilizing  various  techniques  ( e.g .,  see  [5, 
12,  16]),  H  ( t )  can  be  decomposed  to  recover  the  rotational 
component  Re(t)  and  the  scaled  translational  component 

—  Pe(t);  therefore,  Re(t )  and  — Pe(t )  are  assumed  to  be 

Qj-n  d-Tx 

measurable  during  the  subsequent  control  development. 

2.2  Dynamic  Model  of  a  UAV 

In  this  paper,  a  UAV  that  is  fully  actuated  with  respect  to 
orientation  but  underactuated  with  respect  to  translation  is 
considered  (i.e.,  the  UAV  is  equipped  with  only  one  control 
input  (the  thrust  force)  to  facilitate  translational  motion). 
The  control  development  is  focused  on  the  rigid  body  dy¬ 
namics  of  the  UAV.  That  is,  actuator  dynamics  are  not 
considered  within  the  scope  of  the  design.  After  denoting 
v(t),u)(t)  £  R3  as  the  translational  and  rotational  velocities 
of  the  UAV  relative  to  the  inertial  frame  X  expressed  in  the 
body  frame  B,  the  rigid  body  dynamics  can  be  described 


by  the  following  equations  [13] 

P  =  Rv  (7) 

mi)  =  —mS(u>)v  +  Ni(-)  +  Ff  (8) 

R  =  RS(uj)  (9) 

Ju  =  -S{uj)Juj  +  N2{-)  +  Ft  (10) 


where  5(-)  £  R3x3  denotes  a  skew-symmetric  matrix  de¬ 
fined  in  [15],  J  £  R3x3  denotes  the  constant  moment  of  in¬ 
ertia  around  the  center  of  mass  expressed  in  body  frame  B, 
and  m  £  R1  represents  the  constant  mass  of  the  UAV.  The 
term  Ni  ( P ,  v,  R,  t)  £  R3  represents  the  sum  of  gravitational 


forces  and  additional  time  varying  unmodeled  bounded  dy¬ 
namics  such  as  aerodynamic  resistance.  Similarly,  the  term 
N2  (P,v,  R,ui,t)  G  R3  include  unmodeled,  bounded  distur¬ 
bances  within  the  rotational  dynamics.  The  forces  and 
torques  on  the  rigid  body  due  to  the  actuators  are  denoted 
by  Ff(t),Ft(t)  G  R3,  respectively,  expressed  in  the  body 
frame  B ,  and  given  as  follows 

Ff  =  B1U1  (11) 

Ft  =  [  u2  u3  u4  ]T  (12) 

where  «i(t)  G  R1  denotes  the  magnitude  of  the  thrust 
force  and  B 1  —  [0  0  1  J  G  R  is  a  constant 

unit  vector  in  the  body  fixed  frame  B  in  the  direc¬ 
tion  of  the  thrust  force.  The  force  and  torque  inputs 
[  «i (t)  u2{t)  u3(t )  u4(t)  ]  G  R4  are  related  to  the 
corresponding  actuator  control  signals  through  dynamics 
that  not  considered  within  the  scope  of  this  control  design. 
For  example,  the  four  rotor  velocities  ro;  G  R1  for  a  Quad- 
Rotor  UAV  are  related  to  the  rigid  body  forces  and  torques 
via  the  following  relationship  [6] 


Ml 

'  -b  - b  - b  - b 

r  ^2 

TaJ  1 

M2 

0  db  0  —  db 

2 

W2 

«3 

db  0  — db  0 

—J2 

M4 

k  —k  k  —k 

__2 
LX7  4 

where  d  G  R1  denotes  the  displacement  of  each  rotor  rel¬ 
ative  to  the  center  of  mass  of  the  airframe,  and  k,  b  G  R1 
are  constant  parameters  that  depend  on  construction  and 
aerodynamic  properties  of  the  rotor  blades. 


3  Problem  Formulation 

The  control  design  is  developed  under  the  assumptions  that 
the  translational  and  rotational  velocity  signals  v(t)  and 
ui(t),  are  measurable  via  on-board  sensors  and  that  the  UAV 
mass  m  and  the  UAV  inertia  matrix  J  are  assumed  to  be 
known.  In  addition,  the  desired  position  and  orientation  at 
landing,  defined  by  Pd  and  Rd,  respectively,  are  specified. 
The  overall  objective  is  to  design  the  control  inputs  Ff(t) 
and  Ft(t)  to  regulate  the  UAV  position  P(t)  to  the  desired 
landing  position  Pd-  Since  the  UAV  has  only  one  transla¬ 
tional  actuator  oriented  along  a  fixed  direction  defined  by 
the  vector  B 1,  the  force  input  signal  Ff(t)  must  be  designed 
in  conjunction  with  the  torque  input  vector  Ft(t)  to  achieve 
the  desired  objective.  To  this  end,  the  position  regulation 
error  signal  ep(t)  G  R3  is  defined  to  quantify  the  mismatch 
between  the  desired  and  actual  position  of  the  UAV  as  given 
by 

ep  =  -^—Rt(P  —  Pd)  =  —  -^-Pe  (14) 

&7C  CL-j; 

where  the  fact  that  Pd  =  P  +  RPe  has  been  utilized. 

I11  addition,  it  is  assumed  that  a  reference  image  (defined 
by  image  coordinates  ptd)  of  all  visual  markers  from  the 
on-board  camera  when  the  UAV  is  at  the  desired  landing 
configuration  defined  by  Pd  and  Rd,  and  denoted  by  Bd 
is  available.  As  discussed  in  Section  2.1,  the  stereo-like 
imaging  technique  allows  us  to  compute  the  scaled  position 

—Pe(t)  and  orientation  Re(t)  of  the  UAV  relative  to  the 

GL-tj- 

frame  Bd  from  a  sequence  of  images  from  the  camera  on 
board. 


Remark  1  Since  the  desired  landing  configuration  defined 
by  Pd  and  Rd,  and  the  normal  vector  to  the  landing  sur¬ 
face  n, r  are  assumed  to  be  known,  the  distance  dn  can  be 
computed  in  the  following  manner 

d,r  =  —n^RdPd-  (15) 

Hence,  the  scale  ambiguity  in  -j-Pe(t)  from  the  decompo- 

sition  of  homography  can  be  resolved  resulting  in  calcula¬ 
tion  of  Pe(t).  This  allows  for  the  computation  of  the  time 
varying  position  P(t.)  and  orientation  R(t)  of  the  UAV  as 
follows 

R  =  RdR-J  (16) 

P  =  Pd-RPe.  (17) 


4  Control  Development 


After  taking  the  time  derivative  of  (14),  and  using  (7)  and 
(9),  the  open  loop  error  dynamics  for  ev  ( t )  can  be  expressed 
as  follows 

ep  =  —S(oj)ep  +  —v.  (18) 

To  facilitate  the  regulation  of  the  position  error,  a  filtered 
regulation  error  signal  r(t)  G  R3  is  defined  in  the  following 
manner 

r  =  v  +  kpep  +  6  (19) 

where  kp  G  R1  denotes  a  positive,  scalar  constant,  and 
<5  =  [  <5i  82  £3  j  G  R  represents  a  constant  design 

vector  of  positive  elements  that  facilitates  an  advantageous 
coupling  of  the  translational  dynamics  of  the  UAV  to  both 
the  translational  and  rotational  control  inputs.  After  taking 
the  time  derivative  of  (19),  substituting  the  translational 
dynamics  from  (8)  and  the  open  loop  error  dynamics  from 
(18),  the  open  loop  dynamics  for  the  filtered  regulation  er¬ 
ror  signal  r  (t)  can  be  developed  as  follows 


r 


v  T  kpep 
- S(u)r  + 

+  ~Ni  + 

m  d-jr 


—  Bmi  -  S(S)u 

m 


(20) 


where  the  term  S(ui)8  has  been  added  and  subtracted  to 
the  right  hand  side  of  the  above  equation  and  the  fact  that 
S(u)8  =  —  S(8)u>  has  been  utilized.  The  bracketed  terms  in 
the  above  equation  can  be  written  in  terms  of  a  constant 
auxiliary  matrix  B  G  R3x4  and  an  auxiliary  vector  U(t)  G 
R4  in  the  following  manner 


where 


—  B1M1  -  S(8)u  =  BU 
m 


B  = 

U  & 


0  0  S3  — 8  2 

0  -S3  0  <5i 

—  <52  — <5i  0 

L  m 

[  U\  LOl  UJ2  0J3  ]  T  . 


(21) 


(22) 

(23) 


I11  order  to  proceed  with  the  control  development,  the  an¬ 
gular  velocity  error  signal  r/(t)  G  R3  and  the  desired  control 
signal  Ud{t)  G  R4  are  defined  in  the  following  manner 

?7  =  odd  -  w  (24) 

Ud  =  [mi  uTd  }T  (25) 


where  u)d(t)  G  R3  represents  a  desired  angular  velocity  sig¬ 
nal.  From  (23),  (24)  and  (25),  the  following  relationship 
can  be  observed 

u  =  ud-  nTV  (26) 

where  II  G  R3x4  denotes  the  following  constant  matrix 


n  = 


0  10  0 
0  0  10 
0  0  0  1 


(27) 


The  desired  control  input  signal  Ud(t)  is  designed  in  the 
following  manner 


Ud  =  B+Uaux  +  (It 1  —  B+  B)  U self  (28) 


where  B+  =  BT  ( BBT )  1  G  R4x3  denotes  the  pseudo¬ 
inverse  of  the  constant  matrix  B,  I4  G  R4x4  represents 
the  identity  matrix,  Uaux(t)  G  R3  and  Useif{t)  G  R4  de¬ 
note  yet  to  be  designed  auxiliary  control  signals.  In  order 
for  B+  to  exist,  B  must  be  of  rank  3  which  can  be  easily 
satisfied  through  proper  selection  of  the  auxiliary  matrix  6 
( e.g <5  =  [  0  0  £3  ]T  where  £3  ^  0). 

Since  the  term  (I4  —  B+  B)  in  (28)  projects  the  vector 
Uaeif(t)  into  the  null  space  of  B(t),  the  design  of  Use  1  fif) 
has  no  direct  influence  on  the  dynamics  of  r(t).  Therefore 
from  (20),  (21),  (26)  and  (28),  the  open  loop  dynamics  for 
r(t)  are  given  by  the  following  expression 


r=-S(w)r  +  Uaux-  BUtV  +  ^-v  +  Ni  (29) 

dir 

where,  Ni(-)  =  —  JVi(-)  G  R3,  and  the  following  two  prop¬ 
erties  of  the  pseudo-inverse  were  employed  [9] 


BB+  =  I3 
B  (h  -  B+B)  =  0 


(30) 


where  1^  G  R3x3  represents  the  identity  matrix.  Since 
USeif{t)  does  not  appear  within  the  dynamics  of  (29),  the 
auxiliary  control  input  USeif(t)  can  be  designed  to  achieve 
a  secondary  control  objective,  such  as  the  damping  of  the 
orientation  error  of  the  UAV.  To  this  end,  orientation  error 
signal  eg(t)  =  [  ee\{t)  eg2(t)  egs(t)  ]  G  R3  is  defined  in 
terms  of  the  axis-angle  representation  [15]  of  the  orientation 
matrix  Re(t)  in  the  following  manner 


eg  =  pf  (31) 

where  p(t)  G  R3  represents  a  unit  axis  of  rotation,  <f>(t)  G  R1 
denotes  the  rotation  angle  about  p(t)  (confined  to  the  region 
— 7r  <  <f>(t)  <  7 r)  and  is  explicitly  defined  in  the  following 
manner 


where  the  bounded,  invertible,  Jacobian  like  term  L„(f)  G 
R3x3  is  given  by  the  following  expression 


Lu  =  I3  -  (jj)  + 


1  - 


sine  ( <p ) 


sine *  — 


sine  ((f))  = 


sin  ((f)) 


S(nf 


2  J 


(34) 


For  more  details  on  the  derivation  of  (34),  the  reader  is 
referred  to  [2].  The  kinematics  for  the  UAV  can  be  rewritten 
in  terms  of  the  backstepping  velocity  error  signal  rj(t)  and 
the  desired  control  signal  Ud(t)  in  the  following  manner 

eg  =  Lw  (r)  -  II Ud)  ■  (35) 

After  substituting  for  Ud(t)  from  (28),  eg  (t)  can  be  rewrit¬ 
ten  in  the  following  manner 

eg  —  j Luj(]  L^TiB  Uaiixj 

-LuU[I4-  B+B)Useif  (36) 

=  U self  +  IV3 

where  B)O(t)  G  R3x4  is  a  bounded,  differentiable  matrix 
defined  as  follows 


=  Lw  n  (I 4  -  B+B)  (37) 

and  the  bracketed  terms  in  (36)  have  been  redefined  by  the 
single  term  A^)-)  G  R3. 

Based  on  the  subsequent  stability  analysis,  the  control  sig¬ 
nals  UaUx(t)  and  USeif(t)  are  designed  as  follows 

k  C2 

U aux  =  —ep  —  krr  —  -y-v  —  r—  (38) 

dir  £  1 

U seif  =  fceBmTanh(ee)  (39) 

where  kr,kg  G  R1  are  positive,  scalar  control  gains  chosen 
such  that  kp  >  kr  >  0,  £1  G  R1  is  a  positive,  scalar  constant, 
Tanh(ee)  G  R3  is  a  vector  function  defined  in  the  following 
manner 

Tanh(ei?)=  [  tanh(eei)  tanh(ee2)  tanh  (ega)  ]T 

(40) 

and  Ci(')  G  R1  is  a  known  positive,  scalar,  differentiable, 
non-decreasing  bounding  function  selected  such  that 

||^i||<Ci(IMI.,IHI.)  (41) 

and  the  function  ||.||s  is  defined  in  the  following  manner 

\\y\\s  -  VyTy  +  v,  Vy  e  R3  (42) 

where  a  G  R1  represents  a  small  positive  constant. 


4>  =  cos-1  (tr(Re)  —  i)^  =  (32) 

where  the  notation  tr(-)  denotes  the  trace  of  a  matrix.  After 
taking  the  time  derivative  of  (31),  the  kinematics  of  the 
moving  UAV  frame  is  expressed  as  follows  [2] 


(33) 


Remark  2  The  function  in  (42)  has  been  utilized  instead  of 
the  standard  Euclidean  norm  to  ensure  that  the  time  deriv¬ 
ative  o/CiO)  in  (41)  is  well-defined.  The  time  derivative  of 
||.||s  is  expressed  as  follows 


t  ■ 

y  y 

\JyTy  +  <y' 


Vy  G  R3. 


ee  —  — LujOJ 


(43) 


Remark  3  The  subsequent  stability  analysis  will  require 
that  U3eif(t)  G  Coo  be  independent  of  the  boundedness  of 
eg  ft)  thus  motivating  the  design  of  Useif(t)  in  terms  of 
Tanh(eg) . 


The  control  force  input  Ff(t)  can  be  obtained  from  Ud(t) 
in  (28)  as  follows 

Ff  =  B2Ud  (44) 

where  B2  G  R3x4  is  a  constant  matrix  defined  as  follows 


B2 


0  0  0  0 
0  0  0  0 
10  0  0 


In  order  to  design  the  control  torque  input  Ft  ft),  the  open- 
loop  dynamics  of  r/ft)  are  formulated  by  differentiating  (24) 
and  substituting  the  rotational  dynamics  given  in  (10)  as 
follows 

Jir\  =  Jiiid  +  S(u>)  Ju)  —  N2  —  Ft.  (45) 

The  signal  t hdft)  of  (45)  is  computed  from  the  time  deriv¬ 
ative  of  Udft)  in  (28);  moreover  the  resulting  expression 
can  be  written  as  a  sum  of  two  terms  Udift)  G  R4  and 
U  d2  ft)  G  R4,  where  Udift)  is  composed  of  the  known  terms 
of  Uft),  and  U d2(t)  is  composed  of  uncertain  terms  (see  the 
Appendix  for  explicit  forms  of  Udi{t)  and  Ud2ft))-  Hence, 
(45)  can  be  rewritten  as 

Jr,  =  JUDdi  +  S(u)Ju  —  N2  —  Ft  (46) 


where  the  uncertain  terms  have  been  lumped  into  a  single 
term  N2{t)  G  R3  which  is  defined  as  follows 

N2  =  N2-  mud2.  (47) 


After  taking  the  time  derivative  of  (51),  substituting  the 
dynamics  for  ep(t),r(t)  and  »)(t)  from  (18),  (29)  and  (45), 
and  substituting  the  expressions  for  Uauxft)  and  Ft(t)  from 
(38)  and  (48),  the  time  derivative  for  V  ft)  can  be  expressed 
in  the  following  manner 


V  <  -kr 

+ 

+ 

+ 


Ml  Ci  - 
Ml  C2  - 


j2 

llrir  Ci 


||ep||  —  kr  ||r||  -  kr  ||^||' 

l|2  X21 


uhi 


£2 


(52) 


M  \\S\\-k\\epf] 


where  k  =  kp  —  kr  G  R1  is  a  positive  constant  (recall  that  the 
control  gain  kr  in  (38)  is  selected  such  that  kp  >  kr  >  0). 
After  applying  the  nonlinear  damping  argument  from  [8], 
each  of  the  bracketed  terms  in  the  above  expression  can  be 
upper-bounded  as  follows 


WcA'-ihLCi) 

IMOT-fcIM) 


< 

£1 

< 

£2 

(53) 

< 

IMI2 

k 

From  (52),  Vft)  can  be  further  upper  bounded  in  the  fol¬ 
lowing  manner 

V  <  —kr  \\z\\2  +  e  (54) 

where  z  =  [  ep  rT  »)T  ]TgR9  and  £  =  £i+£2+  ^  G 
R1.  Note  that  Vft)  in  (51)  satisfies  the  following  inequality 

0u\\z(t)\\2  <V(t)<012\\zft)\\2  (55) 

where  the  constant  parameters  0n,0i2  £  ®1  are  given  by 


Based  on  the  subsequent  stability  analysis,  the  control 
torque  input  Ft  ft)  is  designed  in  the  following  manner 

^  C2 

Ft  =  JUUd 1  +  S(u>)Ju>  +  krr/  -  YlBTr  +  77^  (48) 

£2 

where  £2  G  R1  represents  a  positive,  scalar  constant,  and 
C2(-)  G  R1  is  a  known  positive,  scalar,  non-decreasing 
bounding  function  constructed  such  that 


/?n 


min 


)  Pl2 


max 


max 


(56) 


and  Amin(J),  Amax(J)  G  R1  denote  the  minimum  and  maxi¬ 
mum  eigenvalues  of  the  inertia  matrix  J,  respectively.  From 
(51),  (54)  and  (55),  the  position  error  signal  ep  ft)  can  be 
upperbounded  by  the  following 


ep(t)||  <  Vft)  <  Qi  exp(— a2f)  +  «3  (57) 


\\N2W  <C2(IMIUMUMD-  (49) 

4.1  Stability  Analysis 

Theorem  1  Given  the  error  dynamics  of  (18),  (29)  and 
(45),  the  translational  force  input  and  the  rotational  torque 
input  developed  in  (44)  and  (48),  respectively,  guarantees 
that  the  position  error  signal  epft)  is  exponentially  regulated 
into  a  neighborhood  about  zero  (GUUB) 

||ep(t)||  <  «i  exp  (— a2t)  +  03  (50) 

where  01,02,03  G  R1  are  adjustable,  positive  constants. 

Proof:  In  order  to  illustrate  the  position  regulation  result 
of  (50),  the  following  non-negative  scalar  function  is  defined 

V  =^dnepep+^rTr+^riTJr).  (51) 


where  oi  =  H(0),  o2  =  — — ,  and  03  =  —  are  positive 
P12  Q2 

scalar  constants. 

From  (54)  and  (55),  it  is  straightforward  to  see  that 
eP{t),r(t),r](t)  G  Coo.  Since  Rft)  G  Coo  and  Pd  G  Coo, 
we  can  conclude  that  Pft)  G  Coo  based  on  the  position 
error  signal  definition  of  (14).  From  (19),  we  observe  that 
v(t)  G  C  OO  5  hence,  UaUxft)  G  Coo-  Based  on  the  fact  that 
ep(t)  and  v(t)  are  bounded,  we  can  use  (18)  to  show  that 
ep(t)  G  Coo-  After  utilizing  (20),  (28)  and  (29),  we  can  deter¬ 
mine  that  rft), vft)  G  Coo,  and  hence,  Uauxft)  G  Coo-  Since 
U ae,if  ft)  was  designed  to  be  bounded  through  the  utilization 
of  Tanh(-),  it  can  be  shown  from  (28)  that  Udft)  G  Coo, 
and  hence,  oJdft),U(t),uift),u>(t)  G  Coo-  Based  on  the  time 
derivative  of  U3eif(t)  in  the  Appendix,  we  observe  that 
U seif  ft)  G  Coo-  Hence  Udft)  G  Coo,  and  therefore,  it  can  be 
shown  that  u>d(t),  Ftft),d}ft),fi(t)  G  Coo-  From  the  preced¬ 
ing  stability  trace,  we  can  conclude  that  Ffft)  G  Coo  from 


(44).  Therefore,  all  signals  remain  bounded  during  closed 
loop  operation.  ■ 

Remark  4  With  Useif(t)  designed  as  shown  in  (39),  the 
expression  of  (36)  can  now  be  written  as  follows 

ee  =  —keB^Bm  Tanh  (e&)  +  N3  (58) 

It  is  apparent  from  (58)  that  Useif(t)  has  been  designed  to 
damp  the  orientation  error  signal  eg(t),  since  Theorem  1 
has  illustrated  that  Nz(-)  6  £00  • 

5  Conclusions 

In  this  paper,  a  nonlinear  controller  was  developed  to 
achieve  position  regulation  of  a  rigid,  underactuated  aerial 
vehicle  during  a  landing  approach  using  position  informa¬ 
tion  obtained  from  an  on-board  monocular  camera.  The 
controller  was  shown  to  achieve  globally  uniform  ultimate 
boundedness  (GUUB)  in  position  regulation  error  despite 
uncertain  bounded  disturbances  in  the  system  dynamics. 
Additionally,  the  null  space  of  an  input  matrix  in  the  con¬ 
troller  was  exploited  to  achieve  a  secondary  control  objec¬ 
tive  of  damping  the  orientation  error  of  the  UAV  relative 
to  the  desired  orientation  at  landing. 
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Appendix  A:  Time  Derivative  of  Ud(t) 

After  taking  the  time  derivative  of  Ud(t)  in  (28),  the  follow¬ 
ing  expression  is  obtained 

Ud  =  B+UaUx  +  (h  —  B+  B)  Uself  (59) 

where  the  time  derivative  of  Uaux{t)  can  be  computed  from 

(38)  as  follows 

Uaux  =  S(Lo)ep  +  ^S(u>)v- fv- d^-BoUa 

dir  dir  mdir 

+  ( kr  +  ^)  (s(w)r  -  Uaux  +  BlTr,  - 

-  (kr  +  +  M  Nx  -  2r^Cr- 

V  £i  an  J  Si 

(60) 

The  time  derivative  of  UaUx(t)  can  be  separated  into  mea¬ 
surable  and  unmeasurable  bounded  terms  UaUxi(t)  and 
UaUx2(t),  respectively,  as  follows 

Uaux  1  =  S{u)ep  +  ^S{u>)v-  fv-  -^-B2Ud 

dir  dir  mdir 

+  (kr  +  ^-)  (s(uj)r  -  Uaux  - 

+BUTri)  -  2r^Cn 

(61) 

Uaux 2  =  -  ( krNi  +  ^-JVr  +  ^ Ni  +  2r  — £12)  (62) 

\  £  l  dir  £  l  / 

where  the  known  and  unknown  terms  in  the  time  derivative 
of  Ci(')  has  been  separated  into  Cn(-)  £  K1  and  Cmt)  £  K1, 
respectively.  Similarly  after  taking  the  time  derivative  of 

(39) ,  the  time  derivative  of  Useif  (t)  can  be  expressed  as 
follows 

Uself  =  BeLl[I- 

diag  (tanh2  (eei)  ,tanh2  (e<?2) ,  tanh2  (eg3))]  ee 
+BgL^Tanh  (eg)  (63) 

where  diag(.)  denotes  a  diagonal  matrix  with  arguments 
as  the  diagonal  entries,  the  constant  matrix  Bg  €  R4x3  is 
defined  as 

Bg  =  kg  (/4  —  B+B) T  nT  (64) 


and  the  time  derivative  of  the  Jacobian  like  term  L„(t)  can 
be  shown  to  be  the  following 


Luj  —  — 


(73+5^2M5^2 

( 


+ 


sine  (4>) 


vsmc  U 


- 1 


/ 


-r  VeJS(n)2 


+  ±S(/x)2eeMT)  -  \s{ee). 


(65) 

The  time  derivative  of  Ud(t)  can  now  be  written  as  a  sum 
of  a  measurable  U  di(t)  £  R4  and  an  unmeasurable  Ud2(t)  £ 
R4  term  each  defined  in  the  following  manner 


Ud  1  =  B  +  Uauxl  +  (II  —  B  + B)  U3elf  (66) 

U  d2  =  B+Uaux2 •  (67) 


